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ABSTRACT 

The construction of an autonomous roving vehicle requires the devel- 
opment of complex data-acquisition and processing systems, which determine 
the path along which the vehicle travels. Thus, a vehicle must possess 
algorithms which can (l) reliably detect obstacles by processing sensor 
data, (2) maintain a constantly updated model of its surroundings, and 
(3) direct its immediate actions to further a long range plan. 

The first function consisted of obstacle recognition. Obstacles may 
be identified by the use of edge detection techniques. Therefore, the 
Kalman Filter was implemented as part of a large scale computer simulation 
of the Mars Rover, Aditional edge detection algorithms were developed to 
deal with several problem situations, and the effects of parameter changes 
on the algorithms were studied. The algorithm proved to be rather 
reliable at ranges of 8 to 25 meters, even in the presence of noise or 
sloped surfaces . 

The second function consisted of modeling the environment. The 
obstacle must be reconstructed from its edges and the vast amount of data 
must be organised in a readily retrievable form. Therefore, a Terrain 
Modeller was developed which assembled and maintained a rectangular grid 
map of the planet. It correctly identified all obstacles based on flat 
terrain but behaved unacceptably on slopes. 

Tlie third function consisted of directing the vehicle's actions. 

The grid map prepared by the Terrain Modeller was used in the classifica- 
tion of routes as acceptable or imacceptable, optimal or otherwise. A 
Path Selection Algorithm which navigated solely with the aid of the map 



V 


vas successfully demonstrated on flat obstacle-stream terrain corrupted 
by noise* 

Each of these algorithms require a large amount of computer time. 
Thus, this approach should be used primarily to determine a general steer- 
ing direction, leaving an efficient short range sensor to map out a 
detailed route. 



1. IMODUCTION 


The space program has recently generated interest in the construc- 
tion of a roving vehicle for the exploration of other planets. The com- 
munications lag between tlars and Earth (on the order of 20 minutes), 
besides the low bit rate available, would compel the vehicle to be fairly 
self-sufficient. Therefore, the roving vehicle must be capable of: 

(1) sensing its environment 

(2) detecting obstacles and storing data in a readily 
retrievable form, and 

(3) directing its immediate actions to achieve some long range 

goal. 

The vehicle obtains information about its environment via a laser 
range-finder mounted on a mast attached ti- the vehicle's front axle. It 
provides range measurements given azimuth and elevation angles. Only 
medium sensor ranges, approximately 10 to 30 meters, are investigated. 

1.1 Historical Review 

The problems of path selection and obstacle detection by an autono- 
mous roving vehicle have already been examined extensively. Krajewski^* 
developed a short range system, Td.th an intended range of 0 to 5 meters, 
which employed laser triangulation techniques. Although results were 
promising, there were problems. Slopes were confused in.th obstacles and 
a less-than-optimal path to target often resulted, due to a path selection 
decision based solely on local features. Thus, the development of 


Superscripts refer to the reference number 



alternate approaches was encouraged. 

Short and mediuia range schemes "based on range comparison techniques, 

'd. 3 

such as those hy Matthews and Sharp , also suffered from noise and the 
confusion of slopes with ohstacles. 

Because of the failure of simple range comparison schemes, several 

Jj. 

edge detection algorithms were developed. These included Reed's Four 
Dimensional Ratio, and the Kalman Filter and Rapid Estimation Scheme de- 

5 

veloped hy Sonolhar and Shen. The Four Dimensional Ratio was not suc- 
cessful in identifying sudden changes in terrain gradient, as is the case 
with the leading edge of a positive obstacle (boulder) on the trailing 
edge of a negative obstacle (crater). However, the Rapid Estimation 
Scheme (RES) proved to be successful in this regard. Implementation of 
RES (see for example, Leung^) offered two more major advantages: (1) the 
distinguishability of discrete obstacles and terrain slope and (2) an 
improved probability of selecting a globally optimal path because of the 
increased information available. 

Path selection algorithms also were approached in a more mathematical 

way. A grid map of the type eventually employed was first developed by 

T S 

Lee and modified by Laliman. 

1.2 Project Summary 

The sensing function of the roving vehicle was implemented in the 
digital computer simulation ^rtth the addition of two programs: a laser 
range-finding sensor and a scan generator. 

The obstacle recognition function was implemented with various edge 
detection schemes such as the Kalman Filter. Other edge detection 
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algoritluns were developed in response to operational problems experienced 
by the Kalman Filter. Noise sensitivity and parameter sensitivity were 
studied. For the first time, the obstacle detection block was physically 
separated from the terrain modelling block. The Terrain Modeller, which 
reconstructed an obstacle from its edges or parts of its edges, was 
developed. The Terrain Modeller also served as the system's memory by 
assembling and maintaining a rectangular grid map of the local planet 
environments . 

The path selection function of the roving vehicle remained the 
eventual objective, however. A Path Selection Algorithm was developed 
for use with the grid map maintained by the Terrain Modeller. 

1,3 Description of the Computer Simulation 

The digital computer simulation of the vehicle is organized into 
five major modules, interfaced aSi shoi-m in Figure 1. 

1.3.1 The Vehicle Dynamics Block 

10 

The Vehicle Dynamics Block is described by Sharp . It simulates 
the vehicle's movement across specified terrain, given the path selection 
decision concerning vehicle heading, velocity, and transit time or dis- 
tance. The behlcle is modelled as a point mass with a front wheel base 
of finite dimensions. 

1.3.2 The Sensor Block 

The Sensor Block consists of a laser range-finding sensor mounted on 
a 1.5 meter mast attached to the front axle of the vehicle. It supplies 
true or noise-corrupted range measurements for specified values of azimuth 
and elevation angles. A scan generator sweeps the sensor through a 




igure 1. Main Program Modules of the Mars Simulation 
Package 
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paorticular field of vision and maintains the required data density. 

1.3.3 The Edge Detection Scheme 

The Edge Detection Scheme must simplify the matrix of range data to 
an array in which only the edges are indicated. 

The Kalman Filter comprises the backbone of the edge detection 
module but additional processing, which was developed in response to 
problems arising during the simulation effort, is included in this gen- 
eral category. Examples of the additional processing are (l) a noise 
filter which removes edges without a certain number of adjacent edges arid 
( 2 ) a "moving average" or type of second difference processing, 

1.3.^4- The Terrain Modeller 

The Terrain Modeller processes the matrix of edges in order to 
identify the obstacle location with respect to the edge. It also creates 
a rectangular grid map of the local planet surface, based on attitude and 
range data. The map serves as the system's memory. The map is continu- 
ously updated with information on target location, vehicle location, 
scanned and unscanned {unknovm) regions, obstacle location and type, and 
the current average terrain height of each block of terrain. 

1 . 3.5 The Path Selection Algorithm 

A path selection algorithm based on the grid map approach of Lee 

8 

and Lallman was developed. However, a more sophisticated blocking scheme 
was employed which identified dead-ends without previous knowledge of the 
location of all the obstacles. A steering decision, velocity, and travel 
distance are output to the vehicle dynamics block. Due to time con- 
straints, the path selection algorithm described here has been only 



minimally employed in conjunction with the remainder of the simulation 
hut its feasibility as an approach has been demonstrated in test situa 
tions . 

The following chapters are devoted to more detailed descriptions 


of each simulation block. 
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2 , THE SEIJSOR 

The Martian Roving Vehicle possesses a laser range-finding sensor, 
mounted on a 1,5 meter mast attached to the front axle. The laser is able 
to focus in several directions, which are defined by elevation angles and 
azimuth angles. The actual directions are determined partially by hard- 
ware constraints and partially by software data requirements. 

The sensor was implemented id.thin the large scsle digital computer 
simulation of the Martian Roving Vehicle. This implementation operates in 
an extremely flexible manner, in contrast to previous sensor algorithms. 

2.1 Hardware and Software Constraints 

A laser range-finder is subject to many hardware and data processing 
constraints. The range-finder must focus at rather precise aximuth and 
elevation angles because of the large range error introduced by a com- 
paratively small angular error. The laser must be able to change its 
focusing angles by motion of the laser, its mast, or a focusing mirror, 
or by simulating motion through replication of the sensing devices. 
Accurate range measurements must then be obtained. Thus, the data scan 
should be essentially instantaneous , or the vehicle must remain station- 
ary, especially if a large field is being scanned. A convention for 
obtaining range values in cases where no laser signal is returned should 
be established. Finally, the data density must be maintained within 


certain parameters , 
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2 . 2 Implementation 

The digital computer simulation divided the sensor functions de- 
scribed above into two classes: scan generation functions and data sens- 

ing functions. The scan generation functions are incorporated into 
MIDSCH, and the sensing functions are simulated in SENSRL. (Both MIDSCn 
and SENSRL are documented in Reference 9-) 

2.2.1 The Scan Generator: MDSCN 

MIDSCN implements the raid-range scanning scheme which obtains the 
pattern of data required by the Kalman Filter and the Rapid Estimation 
Schpe (EES). 

As input, RES requires range data obtained using constant angular 
spacing. The aximuth and elevation angle increments are not necessarily 
equal. Constant angular spacing means that the density of data points 
per unit of terrain will vary considerably at large elevation angles. 
MIDSCN accepts data density control input in three forms: (l) the actual 
values of the angles may be listed, (2) maximum, minimum, and incremental 
angles may be given, or (3) the length, width, maximum point separation 
and distance to center of the scanned field may be specified. Once one 
form of input has been received, all of the parameters listed above are 
calculated and made available to other program simulation blacks. 

The sensor calculates the ranges for all azimuths of a particular 
elevation angle on any single call. The scan generator must call the 
sensor for each elevation angle and provide for time lapse before 
relinquishing control to the next program module. The scan generator also 
sets a flag indicating whether the current position is the same as the 
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previous position. The flag allows other parts of the simulation to 
"become more computationally efficient. 

2.2.2 The Sensor: SENSRL 

SEHSRIr is a laser range-finding sensor which may operate with up to 
fifty different azimuths and fifty different elevation angles simultan- 
eously. Azimuths may take any value in the interval [-90°, +90°], while 
elevation angles are restricted to the interval [0°, +90°]. The angle 
conventions are illustrated in Figure 2. 

The sensor algorithm is implemented as follows. The vehicle atti- 
tude is calculated and the transformation equations from the vehicle frame 
of reference to the planet frame are o"btained. The transformation equa- 
tions are used to find the true planet locations of the laser and the 
point at which its beam would strike ground, assuming perfectly level 
terrain. The line Joining these two points in the planet frame is drawn. 
The sensor steps along the beam from the laser with a small user-specified 
increment until it detects a position below the local ground level, or 
reaches the limit of its sensing range. In the first case, iterations are 
performed using the bisection method until sufficient accuracy is 
attained. "Sufficient accuracy" is user-defined as the error in the range 
measurement SIMSTP, which must be internally converted to an error in 
terrain heights, ERROR, as shown in Figure 2, In the second case, tne 
range is set equal to the sensor limiting range. 

For computational efficiency, an initial guess of the range value is 
employed for all elevation angles except the smallest. The Initial guess 
equals the range calculated for the greatest elevation angle smaller than 



(a) Side view, illustrating elevation angle conventions and 
error calculations 


O'* 


(b) Top view, illustrating azimuth angle conventions 
Figure 2. Sensor Angle Conventions 
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the current one, at identical azimuth angles. If the sensor finds itself 
below the terrain level, a constant is repeatedly subtracted from the 
initial guess until the terrain level is reached. 

IToise may be added independently to each range measurement. The 
noise may be uniformly distributed, or it may be filtered with specified 
mean, ma:cimum, deviation and filter constants. 

Improvements in the sensor simulation are discussed in Section 6,1.1, 
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3. THE EDGE DETECTIOII SCHEI-IE 

The term "edge detection scheme” refers to a collection of edge de- 
tection algorithms which may he employed separately or simultaneously. 

The Kalman Filter edge detection algoritlm received primary atten- 
tion because it had already demonstrated a high degree of success in deal- 
ing with isolated, well-defined obstacles. Noise sensitivity, parameter 
sensitivity, effective range, and minimum obstacle size were determined. 
These studies led to the development of ''Average Processing” , a second 
edge detection algorithm which may be employed alone, or in concert with 
the Kalman Filter. In addition, a noise filter was developed for use with 
either the Kalman Filter or Average Processing. 

Because of the extensive mathematical theory leading to the Kal m a n 
Filter, a brief theoretical summary is first provided. Each edge detec- 
tion algorithm is then explained in detail as implemented, and the results 
obtained are discussed. 

3.1 Theoretical Discussion 

The theoretical basis of the edge detection algorithms is discussed 
below, in preparation for a description of the implementation of each 
algorithm. 

3.1.1 The Kalman Filter and Rapid Estimation Scheme 

The theoretical results summarized below are discussed in depth by 
Sonallcar^^ . 

The Kalman Filter processes a large matrix of data, and attempts to 
detect changes in magnitude or in gradient between adjacent elements. 
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Ranse data obtained from the sensor is stored in a matrix whose top row 
corresponds to the largest elevation angle, and hence whose ranges repre- 
sent the greatest horizontal distance from the vehicle. “The bottom row 
corresponds to the smallest elevation angle and the *east horizontal dis- 
tance. The first column corresponds to the vehicle's leftmost (or most 
negative) azimuth angle, and the last column to the vehicle's rightmost 
(or largest positive) azimuth angle. 

The matrix must be completely processed twice, once row-by-row, and 
once column-by-column, to detect magnitude or gradient changes in one of 
the directions. 

Columns are processed first. Each column is processed separately 

since it is assumed to be independent of all of the other columns. Each 

element of a column corresponds to a stage of the calctilation. A two 

til 

component state vector is defined for the i stage of the calculation. 

It consists the range estimate, and x^, the estimated change in x^, 

obtained from the difference between the present noisy range measurement 
and the previous noisy range measurement z^ The state equation is; 


x.^_ = F X, = 
- 1+1 -1 


1 

0 


where 


f. 

1 


X. 


( 3 - 1 ) 


X . = 


d, 

1 


( 3 - 2 ) 


,th 


and where d^ is the laser range estimate at the i stage, is the dif- 

S*ts Irfll 

ference between the range measurement at the (i+l) stage and the i 


stage, and f^ is the multiplicative factor relating and g. . Thus, 



The factor has ‘been analytically derived for a flat plane approximation 
of the planet surface. Figure 3 illustrates the relationship betfreen 
these parameters. 

At the i^^ stage, both the state estimate x^ and its error covariance 
are calculated. The Kalman Filter is performed at each stage. It con- 
sists of four steps, followed by a Bayesian state estimate. The four 
steps of the Kalman Filter are prediction, innovation, calculation of the 
Kalman Gaia, and correction. Each step and the Bayesian state estimate 
are discussed below in more depth, but the rest of the algorithm will 
first be explained. 

After the completion of the i^^ stage calculations, the (i+l)^'*' 
till 

stage becomes the i stage. T'Then a colinan has been completely processed, 
a new series of calculations is begun on the next column, with no memory 
of the previous column. 

After all of the columns have been processed, the procedure is 
repeated, using the rows for input. Row filtering is a much simpler pro- 
cess than column filtering because only a change in range, not a change 
in gradient is expected. Therefore, only the first element of the state 
vector is retained. There are situations where a gradient change might 
occur, such as when the vehicle is tilted significantly with respect to 
the local vertical. However, the Kalman Filter implemented here has not 
been designed to deal with such a situation. Modifications might be 


deemed necessary at some future date. 
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Prediction 

Prediction is the process whei’ehy a new state estimate is obtained 
from the previous state estimate. The defining equations are: 


X 


i+1 = E(x^^JZ.) = F 


i+l‘ i‘ 


.. X. 

i 1 


“i+l ° 


Where the variables are defined as in Table I. 

The physical interpretation is as follows. Using equations (3-1) 
and (3-2), the state equations become 

d. = d. + g. 

1+1 1 '^1 

®i+l ^i ®i 

Thus, the predicted range is the stan of the previous range and the range 
increment. The predicted range increment is proportional to the current 
range increment. The proportionality constant may be derived theoretically 
for a flat plane, based on the assumption of a constant angular increment 
during the measurement process. 

The covariance matrix provides a measure of the allowed variation in 
the predicted state estimate. 


Innovation 

Innovation is the process whereby the unpredlcted component of the 
state vector is obtained. This component will be compared in a later 
step with state estimates obtained from hypotheses about the edge loca- 


tion. 
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Variable 


B 


Ji 


'M. 


F. 

1 


S. 

1 


H. 

1 

H 

m 

K 

I 

n 

M 

P 


“m 


a 

R 

W. 

1 

X. 
1 


/s 

X. 

1 



z. 

1 


TABLE I 

DEFITJITIOIJ OF KALI-IAII FILTER VARIABLES 
Neme 

■th 

Bayes’ risk for edge at H sta^e 

"tlx 

Cost function for edge at A sta^e, 
iri.th the m hypothesis 

Measured rsinge 

State transformation matrix, defined in Ecv.ation 3-1 

Difference in ran^re between successive 
measured ranges 

Measurement matrix, defined as l1 O] 

Bayes ' risk hypothesis 
Katman Gain 

Identity matrix of order n 

Covariance of the nredicted state vector, x. 

Covariance of the state estimate x^ 

Prior probability of the presence of an edge 
at the m'*'^ stage 

Plant noise 

Observation noise covariance, usually 5 cm 
Plant noise 

Predicted state estimate 
Corrected state estimate 
Unpredicted component of state vector 
lloisy range measurement 
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The defining equations are; 
Y. ” 


" ^ i +1 

- H, .X. , 
1+1 1+1 

" ^ i +1 

[1 0 ] 

'^•'1 

1 



% 

= Z 

- d . 


i +1 

1 



^i+1 " ^^^i+1 ^i+1 ^ 

“ ^i+1 ^'^i+1 ^i+1 ''' ^i+1 


Thus, the estimated noise is simply the noisy measured range minus the 
predicted range. The covariance provides a measure of the noise contained 
in the state prediction. 


Kalman Gain 

The Kalman Gain is a factor which compensates for the state predic- 
tion error. 

The defining equation is: 

T “1 

K = M H W 
i+1 i+1 i+1 i+1 

Physically, the Kalman Gain is a measure of noise, or the presence 
of an edge. 


Correction 

Correction is the process whereby the state estimate is modified by 
the Kalman Gain factor. 

The defining equations are: 
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X. = X, + K. jr. 
1+1 1+1 1+1 1+1 


-E[(x.,_ -x_.){x_- -x_.) ] 
1+1 1+1 1+1 1+1 1+1 


n. 1+1 1+1 1+1 n 1+1 1+1 1+1 1+1 1+1 


Physically, the predicted state estimate is summed with the product 
of the Kalman Gain and the estimated noise component. The corrected state 
estimate is used in the hypothesis testing step to determine the presence 
or absence of an edge. 


Bayesian State Estimate 

After the Kalman Filter has been performed at the i stage, Bayes* 
Risk is used to indicate which of the three hypotheses is most probably 
true. A hypothesis is considered to be true if it has the minimum risk 
or cost function associated with it. 

The three hypotheses are; 

irfli 

An edge occurs at the i stage 

S*tj 

An edge occurs at the (i+l) stage 

Hgi An edge occurs beyond the (i+l) stage. 

*fcii 

Bayes* Risk for the H stage is calculated as follows: 
m =0 

Bayes* Risk weights the probability that an edge occurred at a particular 
stage by the cost c^ of choosing or failing to choose each alternative, 
and by the prior probability of th- occurrence of an edge. Each of the 
numbers p^ and c ^ ^ are arbitrarily chosen weights, which are however 
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11 

subject to a few rules stated by Sonalkar . 

If Hq is deemed, correct (i.e., has the minimum risk B associated 
with it), the hypothesis is accepted and an edge is flagged. Otherwise, 

Hq is rejected and the (i+l)^^ stage becomes the i^'^ stage. The Kalman 
Filter calculations are repeated for the new i"^^ stage. 

3.1.2 Average Processing 

The term "Average Processing" encompasses two separate procedures: 
(l) the calculation of maximum and minimum allowable range increments 
based on a maximum increment of in-path slope, and (2) a second-difference 
computational method. 

The maximum and minimum tolerated range increments are computed for 
each pair of elevation angles , given the maximum permissible increment 
of in-path slope. The minirntm range increment occurs with the maximum 
positive change in slope. The maximum range increment occurs mth the 
maximm negative change in slope. If the maximum increment is larger than 
the limit of the sensor range, the maximum increment is set to the sensor 
limit minus the present range. 

The equations for the maximum and minimum differences are derived 
below. Consider the largest triangle in Figure 

M = 180® - (e + A e) - (90® + s) 

= 9O®-9-A0+s 

where s is the maximum allowable slope increment, 6 is the 
elevation angle, and A0 is the elevation angle increment. 
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Pigure Calculation of Range Bounds During Average Processing 
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By the law of sines, 

sinAQ 

D . 

min 


sin|4 



and 

D . = H, 

man sinld 2 

where D . is the minimum, allowed range increment, and R_ and E_ are 
min 12 

measured ranges. 

To calculate the maximum range Increment, note that the angle between 
the terrain level and the mast becomes 90° + s. Therefore, 

M = 9qo - 0 - A0 - s 


and 


D 

max 

where D is the maximum allowed range increment, 
max “ 

The other procedure denoted by "Average Processing" is a second 
difference calculation- The difference in range values for each succes- 
sive pair of elevation angles is calculated at each stage. The difference 
is compared to an average difference calculated over the previous stages. 
If the absolute value of the difference of these values is greater than a 
specified fraction of the average difference, an edge is indicated. The 
average difference is updated in two ways. If an edge occurred, the 
average difference is set equal to the most recent difference. If no 
edge occurred, the average difference and the ctirrent difference are 
averaged with a positive integral weighting factor for the average 
difference and a weight of 1.0 for the current difference. 


sinA9 

sinl'l 




M > 0 


sensor 


limit — 
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3.1.3 The IToise Filter 

IToisy data sometimes resulted in the occurrence of spurious edges. 
It was assumed that the prohahility of adjacent spurious edges was small 
compared to the prohahility that an existing edge would not possess a 
neighbor. Therefore, an edge which did not possess an ad^Jacent edge 
was declared spurious and was ignored. 


3 . 2 Umplementat i on 

Impl mentation of the algorithms described above involved a diversity 
of tasks such as interfacing them with the existing computer simulation, 
testing their response to different types of terrain, designing additional 
processing to improve response, studying the effect of parameter changes, 
studying noise sensitivity, and discovering some optimal set of parameters 
useful for the path selection process. 

3.2.1 The Kalman Filter Subroutine Package 

The Kalman Filter subroutine package consists of eight distinct pro- 
grams: KALMAI^, KF, KFl, BES, PRDCT, ABAT, MTADD, and MTHUL. These are 

documented in Reference 9* 

KALMAh contains the master logic for processing a matrix through the 
K alm an Filter, as described in Section 3.1. KFl and RES are used for row 
processing only. They obtain new state and error covariances given the 
present state (this is the Prediction step). KFl bases its calculations on 


the hypothesis that a jump occurred at the present stage, while RES uses 
the alternate hypothesis that a jump will occur at some later stage. Kine 


state estimates, denoted x., , are computed at the i stage. These are 

jk 

comprised of the state estimates for the i^^, (i+l)®^, and (i+2)^'^ stages 


5 
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(or 0 = 1 , 2, 3 respectively) , based on each hypothesis and 

(or k=l,2,3 respectively). The predicted state estimates are processed 

through the remaining steps of the Kalman Filter and then compared using 

Bayes’ Risk. The state estimate with minimum associated cost is chosen. 

If an edge occurred at the i “ stage, it is indicated within the matrix 

as an ’O' or vertical edge, since it was identified by horizontal pro- 

cessing. If it is judged that an edge occurred at the (i+l) or (i+2) 

st til 

stage, no edge is indicated. The (i+l) stage becomes the 1 stage, and 
the entire process is repeated. The first state estimate in each row is 
the actual noisy measured range of the first column of that row. 

Columns are processed similarly using PRDCT, which assumes a jump 
occurs at the present stage, and KF, which assumes that the jump occurred 
later. The first state estimate vector in each column consists of the 
measured ranges between the next-to-last row and the last row. State 
estimates are updated by Equation (3-1). The factor f^ has been 
analytically derived for a flat plane, assuming a constant increment in 
elevation angle between rows. If a horizontal edge is identified, it is 
indicated by a (or an "X" in array positions where both horizontal and 
vertical edges were detected) . 

The remaining subroutines ABAT, MATADD, and MATMUL are utilities for 

matrix addition, multiplication, and the computation of terms of the 
T 

form ABA , resepctively. 

The Kalman Filter is controlled by the same input as the sensor: 
information about maximum, minimum, and incremental values of the azimuth 
and elevation angles. The only additional input needed is the parameter 



UJUMP. Slope changes larger than UJUMP meters per meter will undergo 
additional processing to update the state and error covariance. Addition- 
ally, the programmer may change the costs and prior probabilities of the 

11 

occurrence of and edge accordir^ to rules described by Sonalkar . 

3.2.2 Average Processing 

Test cases processed by the Kalman Filter indicated that detection of 
the near edge of a positive obstacle or the far edge of a negative obstacle 
is extremely sensitive to parameter values. Detection of these edges 
require a rather sparse placement of data points in order to obtain a 
large enough change in range or gradient. Hence, the size of an obstacle 
which could remain undetected might be unacceptably large. Average 
Processing attempted to overcome this difficulty by trying to detect 
those edges where only gradient changes occurred. 

The theoretical description of Average Processing may be found in 
Section 3.1.2. Average Processing ^d.11 not automatically be performed by 
the system, as the Kalman Filter is. If desired, it must be enabled by 
the user through a flag. 

Average Processing is performed only on elements of the columns of 
the range matrix, simultaneously with the Kalman Filter. Each column is 
assumed to be independent of the others. 

Average Processing requires a three-user specified parameters: S, 
THRESH, WEIGHT. S is a positive mzmber indicating the maximum permissible 
increment in in-path slope. THRESH is a threshold value, usually set to 
1.0. To set up the threshold test, the current difference is first subtrac- 
ted from the average difference and the absolute value is computed. This 
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absolute value is then compared to the average difference. If their ratio 
is larger than THRESH, an edge is indicated, VffilGHT is the ’weighting 
factor of the average difference relative to the current difference 'when 
updating the average difference. 

During Average Processing, both the allowable slope calculation and 
the second-difference calculation are performed. 

3.2.3 The Iloise Filter 

Tests performed on the Kalman Filter using noisy data indicated that 
spxirious edges sometimes occurred. Therefore, the entire edge matrix was 
filtered again. Filtering the matrix as a whole is advantageous because 
of the availability of a global view rather than the simple single stage 
outlook of the Kalman Filter, 

Each edge is exemined individually. If an adjacent edge exists 
(in an adjacent row or column position only, not in a diagonal position), 
the edge is assumed to be correct. Othenfise, it is spurious and is 
therefore erased. Diagonal edges (those indicated by are addition- 

ally examined for edges that are adjacent diagonally before erasure. 

The noise filter option must be activated by a user-input flag 
IJIFIL. It is not a system default. 

3 . 3 Results 

Prior demonstrations of the Kalman Filter had always employed a 
single large obstacle on flat terrain in the center of the field of view. 
The type of obstacle to be detected, and its size and position were always 
Imown. The test cases shown here attempt to focus on other problems. 
Eventually, a completely unknown terrain must be satisfactorily scanned. 
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in order for a path selection algorithm to he successful. 

An upper hound on the size of undetected obstacles first had to he 
established. At ranges of 10 to 15 meters, with elevation angle incre- 
ments of 0.1°, boulders of 0.5 meters diameter were detected by the 
Kalman Filter whereas those of 0.25 meter diameter were not. However, 
Average Processing was able to detect boulders of 0.25 meters in diameter, 
but failed for diameters of 0.125 meters. As a rule of thumb, the Kalman 
Filter requires about eight data samples from an obstacle before detection 
occurs, whereas Average Processing requires three (assuming no large, 
easily detectable edge is available). 

Further range studies indicate that the optimal operating range for 
the Kalman Filter in this simulation is approximately 8 to 25 meters. At 
short ranges, the difference in ranges is large compared to the actual 
range. At long ranges, the differences are a very small fraction of the 
total range, or the diameter of the smallest detectable obstacle is 
rather large. Both of these effects diminish the effectiveness of the 
Kalman Filter. 

Detection of the near edge of a boulder or the far edge of a crater 
requires a particular relationship between parameters. The laser height, 
horizontal distance to obstacle to be detected, and elevation angle incre- 
ment must combine to yield a horizontal distance of approximately 0.5 
meters between data points on level terrain. These parameter relation- 
ships are illustrated in Figure 5, where AD should be approximately 0.5 
meters. Typically, the values are set to a laser height of 1.5 meters, 
a nominal scanning range D of 10 meters , and an elevation angle increment 
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Figure 5. 


Parameter Helationships for Edge Detection 
V/ith the Kalman Filter 
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A3 of At 20 meters, the elevation angle increment A0 is 0.2° with 

a laser height of three meters. Figure 6 shows the results of such a 
scan. Other results obtained with the Kalman Filter are also quite prom- 
ising. Figures J and 8 show the results of scans over a cylindrical 
boulder and a crater, respectively. 

Average Processing has been extremely effective in detecting the 
entire obstacle even when the ideal data point spacing described above is 
not used. Figures 9 and. 10 show the results of Average Processing when 
applied to a boulder and a crater, respectively. Note the accurately 
rounded shape of the near and far edges. Values of 1,0 for THRESH, the 
edge threshold value and 3.0 for T'lEIGHT, the average weighting factor, 
have been shown to be the most effective. The process is extremely sensi- 
tive to the value of THRESH. In general, Average Processing is also 
sensitive to noise in the range measurements and should not be used where 
noise amplitude may exceed 0.2 meters. 

The Kalman Filter was also tested with noise-corrupted range measure- 
ments, where the noise consisted of unfiltered white noise of a specified 
maximum amplitude. The approximate distance from the vehicle was 10 
meters. Hoise of 0.1 meter maximum amplitude {2%) did not affect edge 
detection results, as shown in Figure 11. Hoise of 0.2 meter maximum 
amplitude {k%) could be successfully filtered by the noise filter. See 
Figures 12(a) and 12(b). Noise of 0.3 meter maximum amplitude (6/5) began 
to cause spurious edges which could not be filtered out, as shown in 
Figures 13(a) and 13(b). Spurious edges consisted mainly of horizontal 
edges. This was not entirely unexpected. Horizontal edges result from a 
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Figure 6. Two Meter Diameter Spherical Boulder at T^^enty Meters 
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Figure 7. One Heter Diameter Cylindrical Boulder at T%*.snty Meters 
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at Twenty Meters 



Figure 9 
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Average Processing Applied to a One Meter Diameter 
Boulder at Ten Meters 
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Figure 10. Average Processing Applied, to a One Meter 
Diameter Crater at Ten Meters 
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Figure 11. One I-Teter Diameter Boulder at Ten Meters Corrupted 
by Uniform 0.1 Meter Maximum Amplitude Noise 
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Figure 12. One Meter Diameter Boulder at Ten Meters with 
Uniform 0.2 Meter Maximum Amplitude Noise 
(a) Kalman Filter 
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Figure l2. One Meter Diameter Boulder at Ten Meters with 
Uniform 0.2 Meter Maxirntun Amplitude Noise 
(Td) Kalman Filter and Noise Filter 
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Figure 13. One Meter Diameter Boulder at Ten Meters with 
Uniform 0,3 Meter Maximum Amplitude Noise 
(fe) Kalman Filter and Noise Filter 
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two stage prediction process; the first predicts what the true next state 
should he, and the second predicts what the next state could he if edges 
occurred at different stages. lioise cor3:Tapts both stages of prediction. 

In contrast, vertical edges result from a single stage prediction process 
since the true value of the next state is already known, and only the 
edge predictions must he taken into account. 

Other test cases showed that the edge detection scheme developed 
here performed quite well. It identified partial obstacles (Figure ih), 
double obstacles (Figure 15) > obstacles on sine waves, and obstacles on 
sine waves with noise (of 0.2 meter maximum amplitude). It correctly 
flagged a small amplitude sine wave as no obstacle and a large amplitude 
sine wave as an obstacle. Higher masts or close ranges are needed in 
order to identify a large sine wave as a continuous function. 

Problems inherent in the Kalman Filter become evident only in the 
Terrain Modeller, the next stage of computation. Because the Kalman 
Filter is perfomed left to right and bottom to top, the delineation of 
the obstacle is incorrect by one stage on the right side and the top. For 
example, the Kalman Filter will not detect the actual right edge of the 
boulder as an edge, because it is the next stage which actually represents 
the jump in range. Fort^lnately this type of error is only a slight 
inaccuracy rather than a serious miscalculation. Examples of this error 
will be seen in Terrain Model outputs. 
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Figure 1^+. Partial Boulder at Ten Meters 
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Figure I5. Boulder Partially Obscuring Another Boulder 
(a) Kalman Filter 
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Figure 15. Boulder Partially Obscuring Another Boulder 
(b) Kalman Filter and Average Processing 


U. THE TERRAIN MODELLER 


The Terrain. Modeller must orsaniae the mass of data obtained from 
the Sensor and Edge Detection Blocks into a form that may be i'eadily 
interpreted by the Path Selection Algorithm, The approach taken here 
requires the Terrain Modeller to reconstruct the obstacles from their 
edges and to note the location of each obstacle on a rectangular grid map 
of the local planet surface, 

h. l Discussion of Modelling Algorithm 

The Terrain Modeller must be able to reconstruct the shape and 
extent of an obstacle, given only its edges. Complicated problems in 
obstacle Identification are commonplace, as for example, partial obstacles 
(where matching edges do not occur in the sensor field of view) or double 
obstacles (where distinct edges do not occur in the sensor field of view) , 
The Terrain Modeller assumes that the Kalman Filter is absolutely correct, 

i. e., that the occurrence of an edge implies the presence of an obstacle 
at that point, although not necessarily on either side of it. 

Another function of the Terrain Modeller is to maintain information 
about each obstacle in its memory, because of the limited sensor field of 
view and the high cost in time and computational effort in identifying 
each obstacle. The forms of memory chosen were a rectangular grid map and 
a terrain height memory. The rectangular grid map of the local planet 
terrain contains symbols indicating whether each square of the map is 
clear, unknown, or full of obstacles. The terrain height memory is an 
additional matrix whose elements are in one-to-one correspondence with the 
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squares of the grid map. Each element of the terrain height memory con- 
tains the current average of all sampled terrain heights up to the present 
time which fell trithia the corresponding square on the grid map. 

4.2 Implementation 

The Terrain Modeller MODELL receives the edge ma,trix from the Edge 
Detection Bloch. It must decide for each edge whether an ohstacle lies on 
either side of the edge or on hoth sides. Therefore, some sort of range 
prediction function must he obtained, in order to identify obstacles by 
comparison of the actual range with the predicted range. The range pre- 
diction function used by MODELL is the simple assumption that the terrain 
slope is constant, and it therefore is identical to the vehicle attitude. 

The Terrain Modeller MODELL divides each row into segments. It 
possess each segment of each row separately. The segments consist of 
{l) the first element, and all succeeding elements up to but not including 
the first edge, (2) the edge itself, (3) all elements up to but not 
Including the second edge, (4) the edge itself, etc. The process contin- 
ues until the last column of that row has been processed. 

Segment processing consists of (l) averaging the ranges corresponding 
to all elements comprising the segment, (2) subtracting the range estimate 
obtained from the range prediction function, and (3) comparing the remain- 
der to a threshold value. The threshold value is a positive number 
(presently 0,25 meters), A difference in ranges larger in absolute value 
than the threshold signals an obstacle, where a positive (negative) differ- 
ence implies a negative (positive) obstacle, and a difference smaller in 
absolute value than the threshold indicates no obstacle. The edge itself 
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is processed similarly except that a threshold value is not employed, 

(By assumption, a Kalman Filter edge automatically implies the presence 
of an obstacle there,} Thus, the edge matrix is replaced by a matrix 
containing only "P** (indicating a positive obstacle, such as a boulder), 

''K'' (indicating a negative obstacle, such as a crater), or blank (no 
obstacle ) . 

During tests , it was noted that a segment would sometimes be artifi- 
cially continued because one edge was identified by the Kalman Filter and 
the other edge was not. To correct this problem, a noise filter is 
applied. The noise filter will erase any or "N" indicator which is 
not a Kalmpn edge itself or is not directly adjacent to one unless it has 
three or more adjacent edges. 

The ohstacle matrix is next transferred to a rectangular grid map of 
the local terrain. The Terrain Modeller calculates an appropriately 
placed coordinate system for the grid map. The origin coincides with a 
particular element. The positive x-axis of the planet is then assumed to 
be that part of the row containing the origin, which lies to the right 
of the origin. The positive y-axis is that part of the column containing 
the origin which lies above the origin. Because vehicle attitude, azimuth 
and elevation angles, and the range of each point in the edge matrix are 
known, the planet rectangular coordinate of the intersection of the beam 
with the surface may be calculated. The obstacle type indicator (positive, 
negative, or no obstacle) is transferred to the correct grid location and 
the actual height is recorded in a terrain height matrix, which maintains 
an average of all terrain heights measured up until that time for each 
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square of the terrain map. 

Each element of the terrain grid map represents a square of the 
planet surface vith dimensions specified by the user. The program MODELL 
sets up vehicle and target locations, and changes the obstacle type 
indicator flag in each square to a ’’U*', to indicate that it has never 
been scanned, aud hence is totally unlinown. MODELL assumes that some type 
of onboard short range sensor is operable and that Initially the terrain 
is traversable from the vehicle to the point where the mid-range sensor 
becomes available. Therefore those squeares are indicated as clear 
(blank) . 

The terrain grid map contains an obstacle type indicator for each 
square of the map. It may be set to "P", "N”, blank, or (positive, 
negative, clear, or unknown). The indicators "P" or *'N" will never be 
replaced with a clear or unlmown signal, but the most recently calculated 
value of ''P" or "I!!" will take precedence, if there happens to be a con- 
flict concerning the type of obstacle. 

The terrain height memory is updated by a rather complicated calcula- 
tion. It must maintain an average of all sampled terrain heights within 
the corresponding square of the grid map. Memory space may be saved by 
incorporating two pieces of information in one height matrix, instead of 
introducing another matrix which remembers the number of samples previously 
averaged. Thus, a true average may be calculated instead of weighting the 
most recent sample most heavily. Multiple data may be stored in one matrix 
by the use of place value. Thus, the thousands digit and higher order 
digits record the number of samples represented by the average. The ones 
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and tens digits represent the average height. However, negative heights 
cannot be represented without affecting the thousands digit unless the 
hundreds digit is non-zero. Thus, the hundreds digit is set to a zero 
level of 5 initially. Some examples will clarify this procedure. The 
entry 5502.6 represents an average height of (502.6-500,0)= +2.6 meters 
obtained after five samples. The entry 7498*3 represents seven samples 
with an average height of (498.3-500.0)= - 1.7 meters. 

The actual programmed calculation is as follows. The terrain height 
of each square is initialized to a value of 500.0 (corresponding to the 
zero level for each grid square) . Every time that the square is scanned , 
1000.0 is added to the value of the height. Thus the integral number of 
thousands indicates the number of times that the square has been sampled. 
Also the 1000-modulus (or remainder after all integral thousands have 
been subtracted) is averaged with the terrain height just calculated, and 
re-adjusted to a zero level of 500.0. The lOOO-modulus is weighted by 
the integral number of thousands in the averaging process. Thus a true 
average of all of the sampled points is maintained. For example, an 
average of 4500,5 with a current sample height of 0.75 meters wovild yield 
an actual average height of 

(4 samples x 0,5 meters + 1 sample x 0.75 meters )/5 samples 
=0.55 meters 

which would be recoded as 5500.55* 



U.3 Eesults 

In general, the Terrain Modeller has "been very successful in correc- 
tly identifying obstacles, including partial and multiple obstacles, and 
obstacles whose measurements have been corrupted by noise. Some examples 
are shown in Figures l6 through l8. 

However, sine waves and other curved terrains cause a very poor per- 
formance. Obstacles placed on sine waves are cor_ectly identified, but 
the positive parts of the sine wave surface are identified as positive 
obstacles, and the negative parts, .o negative obstacles, as in Figure 19. 
This is a direct result of the algorithm used to obtain a range estimate 
which is then compared with the actual measured range. 

The range estimation algorithm assumes that the terrain has a con- 
stant slope, which can therefore be measured by the vehicle gyro. Hence, 
the vehicle itself sees only a flat plane. This is a rather poor approxi- 
mation since the slope estimate is based on an extremely small portion of 
the total terrain, and because it assumes a planar type of terrain, 
excluding such terrains as sine waves or other gently rolling surfaces . 

A method which approximated the planet surface between the vehicle 
and the sample point as a single variable polynomial o’orve was also tried. 
It failed because it did not incorporate sufficient general information 
and hence had to be recalculated many times. Thus it lacked contiruity, 
and also required a lot of computational effort. 

The rectangular grid map is an excellent way to store terrain data. 
The user may adjust the fineness or coarseness of the grid size to accom- 
modate the desired level of detail. Caution must be used to adjust the 
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Figure 16. 


Terrain Modeller Processing of the One Meter 
Diameter Crater Shown in Figure 10. 

(a) Obstacle Identification 


51 - 


■<r 

£ 

$ 

£ 

S 

£ 

$ 

S 

£ 

£ 

£ 

S 

$ 

£ 

£ 

$ 

S 

$ 

£ 

£ 

S 

S 

S 

£ 

$ 

S 

£ 

£ 

£ 

£ 

£ 

£ 

$ 






£ 

£ 

$ 

S 

£ 


K Negative Obstacle 


N 


^ k 
£ 


^.18m . 


s 




N 

Nt 

N 

N 

N 

N 

N 





£ 

s 

N 

N 

N 

N 

Nt 

N 

N 

N 

N 

N 


1st 

N 


£ 

£ 

N 

N 

N 

N 

N 

N 

N 

N 

N 

N 

N 

N 

N 


S 

$ 

N 

Nl 

N 

N 

N 

N 

N 

N 

N 

^1 

N 

N 

N 


«. 

£ 

N N 

rv) 

N 

N 

N 

N 

N 

N 

M 

N 

N 

N 

N 

\ 

S 

£ 

N 

N 

N 

N 

N 


N 

N 

N 

N 

N 

N 

N 


$ 

S 

N 

N 

N 

N 

N 

N 

N 

N 

N 

N 

N 

N 

N 


£ 

£ 


N 

N 

N| 

N 

N 

M 

N 

N 

N 

N 

N 



£ 

$ 




N 

N 

N 

N 

N 

N 

N 





£ 




1 234567890l234S67agol2 

^ ^ 


Figure 16. Terrain. Modeller Processing of the One Meter 
Diameter Crater Shoim in Figure 10, 

(b) Noise Filter 
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Figure 1?. Terrain Modeller Processing of a One Meter 
Diameter Bculder at Ten Meters 
(a) Obstacle Identification 
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Figure 17, Terrain Modeller Processing of a One Meter 
Diameter Boulder at Ten Meters 
(b) Noise Filter 
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Figure 18. Terrain Modeller Processing of Double Obstacle 
of Figure 15 
(b) Noise Filter 
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Figure 19. Terrain Modeller Processing of 1.0 Meter 
Amplitude Sine V/ave 
(a) Edge Detection Output 
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Figure 19. Terrain I'lodeller Processing of 1.0 fleter 
Amplitude Sine Wave 
(b) Obstacle Identification 
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grid size along with the elevation angle increment in order to avoid 
creating gaps of unknown region in the midst of the scanned region. 

Kiere are two other minor problems. One problem has previously been 
discussed in Section 3.3. The right edge or top edge of an obstacle may 
consist of spurious edges. However, the spurious edge is classified as 
an obstacle and placed in the grid map's memory. Thus, the second problem 
arises. With the present program logic, a square containing an obstacle 
can never be declared clear. It has not yet proved necessary to challenge 
this assumption. Noise and spurious edges may eventually become a serious 


problem, though. 
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5. THE PATH SEIECTIOH ALGORITHI.I 

The Path Selection Algorithm is the program block which closes the 
loop in the computer simulation. The Path Selection Algorithm uses the 
rectangular grid map generated by the Terrain Modeller to evaluate accept- 
able paths to the target. A modified form of an existing algorithm was 
implemented, and promising results were obtained. 

5.1 Discussion of Algorithm 

The Path Selection Algorithm must generate a set of steering com- 
mands, given the rectangular grid of the terrain. Several simplifying 
assumptions have heen made to facilitate a first pass at the problem solu- 
tion: 

(1) The vehicle dimensions are such that it can be contained in 
only one sq.uare of the obstacle grid map (usually one meter by one meter), 

(2) the vehicle may choose only 0°, 90°, l80°, or 270° as heading 
angles, i.e., it may travel only from its present square to an adjacent 
square, and 

(3) there is a short-range sensor aboard which would prevent the 
vehicle from hitting an obstacle which had slipped through its rather 
narrow mid-range sensor screen. 

Q 

A path selection algorithm created by Lallman^ dealt with much the 

same situation, although his assumptions differ from the above, particu- 

7 

larly as to the amount of sensor information available. C. Y. Lee 
developed a method for obtaining a minimal length path given such a grid 
containing obstacles, and this method has been modified and adapted for 




« 
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use here. Lee's algoritlm assumed that all obstacles are known before 
any part of the path is chosen. He then numbered adjacent squares outward 
from the target to the present location with ascending positive integers. 

A minimal path consisted of traveling from one square to any adjacent 
squares containing a lower number. (Refer to Figure 20 for an illustra- 
tion of this procedure.) 

Ihe path selection problem here differs drastically from Lee's prob- 
lem in at least one respect. The presence or absence of obstacles is not 
known in advance. Therefore, two different matrices are used in making 
a path selection decision. One matrix is the terrain grid map maintained 
by the Terrain Modeller. It determines which squares are clear and which 
squares contain obstacles. The second matrix is called the Path Selection 
Map. Its squares are placed in one-to-one correspondence with those of 
the terrain grid map. The purpose of the Path Selection Map is to repre- 
sent the priority that each square on the grid map has when a path selec- 
tion decision is being made. The numbers provide a guideline for choosing 
a "near-optimal” path. The priority numbering system is similar to Lee's 
Algorithm, except that all of the squares are numbered as part of the 
initialization, assuming that no obstacles are present. The numbering of 
the squares is not altered during the entire simulation, except in the ways 
described below. This scheme prevents ambiguous or unnecessary renumber- 
ing whenever new information becomes available. 

5 • 2 Impl ement at ion 

A path is selected with the aid of the Path Selection Map described 
above. Usually, the vehicle will proceed from its present square to an 
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Figure 20. Lee*s Algorithm 
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adjacent square wliose priority number is one less than the priority 
number of the present square. However, there are two cases in which a 
square's priority number must be altered to prevent normal access to the 
square. The first case is when the corresponding square of the grid map 
contains an obstacle. The second case is when the normal priority scheme 
will lead the vehicle to a dead end. 

Squares that correspond to obstacles are renumbered so that they 
contain niimbers larger than any present in the matrix through the normal 
adjacent squares numbering plan. For example, a 50 tiy 50 matrix causes 
them to be renumbered to 99* 

The matrix is then processed to search out and block dead end 
squares. Any square that has no adjacent squares containing a lower 
number is indicated as a dead end. Its square ntunber is changed to the 
corresponding negative integer. 

A crude short range sensor, which detects boulders and craters, is 
also simulated. 

The path selection decision logic ranks its options in the following 
order of importance. 

(l) Only one step (or square) may be taken between scans. 

{2} A path which will place the vehicle in a square containing 
an obstacle may never be selected. 

(3) If the present square of the vehicle is indicated as a dead end 
{i.e., its path selection number is negative) then proceed in the direc- 
tion of the nearest clear square, that is not a dead end. If the vehicle 
is totally blocked, go to the emergency algorithm. If the present square 


« 
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is clear; 

(U) Step to the adjacent square with the next smaller integer. 

(5) If the square containing the next smallest integer is a dead end, 
step to an adjacent square with the next largest numher. 

(6) If a lower number cannot be found, check the special case where 
vehicle and obstacle are on a straight line with the target, Proceed, if 
possible, to the adjacent square with the next largest integer that is not 
a direct line with the target. 

(7) If no decision has yet been reached, back up and block the 
square. 

(8) If a backup is impossible, call the emergency algorithm. 

The emergency algorithm is also called from the vehicle dynamics 

block and thus must contain some redundancy with the above algorithm. It 
will first attempt to back out of the problem situation, proceeding to the 
next larger number. If no way out is found or the number of calls to the 
emergency algorithm exceeds a user-specified maacimum, the simulation t'dll 
be terminated. The simulation is also terminated if the vehicle leaves 
the mapped area. 

5 . 3 Results 

The test cases shown in Figures 21 through 2h Illustrate the per- 
formance of the Path Selection Algorithm. These were not run as part of 
the entire simulation package because of time and money considerations . 

A test program was designed, however, to fully demonstrate the capabili- 
ties of the Path Selection Algorithm itself, without introducing any 
system interface problems. 
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Figure 23* Navigation Arotmti A Keyhole 
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The vehicle successfully chose a path around a houlder, a vail, a 
set of walls, and it avoided a heyhole that it had not yet entered, while 
choosing an optimal path. For example, refer to Figure 21. Part (h) 
shows the priority numbering of the Path Selection l-kp. According to 
rule (3) above, the vehicle proceeded to the right to the nearest clear 
square, and then chose a path to the target by following a descending 
sequence of numbers, by rule (if). 

This powerful algorithm has been able to more fully utilize and 
interpret the large amount of information available than any other path 
selection algorithm to date. Another test case, not shown, consisted of 
a keyhole that the vehicle had already entered. This caused the vehicle 
to wander aimlessly without making any progress. Thus, a new procedure 
for defining dead ends may be needed. 

A single test case involving the entire simulation package was run 
closed-loop and the resvilts are shown in Figure 25. The vehicle initially 
faced towards the reader. It turned to the target and after five scans 
it had opened a path to the target. Unfortunately, monetary considera- 
tions forced a halt at this point. Therefore, the approach described 
here is definitely a feasible, although expensive solution. 
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6. EECOMMEJIBATIONS MD COITCLUSIOKS 

The results obtained from the computer simulation have been evaluated. 
The recommendations are divided into two classes, namely those that pertain 
to the simulation itself, and those concerning the perfomance of the 
algorithms . 

Each module is evaluated separately, and some general conclusions 
are then drawn. 

6.1 Recommendations 

Each of the four program modules previously described may be 
improved. The following sections list specific recommendations to 
improve both flexibility and simulation accuracy. 

6,1,1 The Sensor 

The sensor may be improved in several ways , which may be easily 
implemented within the existing simulation. 

A more realistic sensor simulation coul L be achieved by the addition 
of noise to the specified values of azimuth and elevation angles. Noisy 
sensor angles facilitate simulation of errors in attitude measurement and 
the finite precision in the mechanical placement of azimuth and elevations. 

Noise currently being addetl to bhe range measurements should be 
modified by a factor proportional to the range squared. This would 
provide a more accurate model of the physical process of loss of the 
return signal. 

The field of view might also be expanded by allowing for additional 
azimuth and elevation angles. More efficient processing might be obtained 



Isecause of the reduction in the number of scans required to obtain 
information about the environment . However , a trade off between computer 
btorage and computational efficiency would then exist. 

6.1.2 The Edge Detection Scheme 

There are several approaches which could be taken to further improve 
the edge detection algorithm. 

One way to solve the problem of the delayed edge discussed in 
Sections 3*3 and 4.3 would be to perform the Kalman Filter again, revers- 
ing the direction of processing (right to left, top to bottom). The 
resulting edge matrices would be compared and the correct edge locations 
would be synthesized from their union. 

System performance in the presence of noise should be studied with 
respecT. to the parameters B, C, and R, which have remained fixed through- 
out this study. The B matrix is a matrix of prior probabilities ^f the 
occurrence of an edge. C is the cost matrix where C.. is the cost of 
the i decision (about edge location) given the hypothesis (about 
the edge location). R is the assumed plant noise variance, presently 
equal to 0.0025 square meters. 

Maximum and minimum slope processing might also be handled in a 
somewhat different manner. Special indicators could be used to distin- 
guish slope problems from discrete obstacles. Becuase the vehicle atti- 
tude is known, the maximum and minimum values of incremental slope might 
also be used to test for maximum and minimum values of absolute slope. 
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6.1.3 The Terrain Modeller 

It is absolutely imperative that an improved method of obtaining 
range estimates be developed. This would assure that curved surfaces 
would be correctly identified, instead of being flagged as obstacles. 

From experience, the range estimation function should probably be a two- 
variable curve such as a plane. However, it should preferably be of 
degree two in order to accommodate some nonlinearity. 

Other improvements which might conceivably be justified are: 

(l) development of an algorithm to remove a spurious obstacle from the 
grid map, and (2) expansion of the memory storage of the grid map, allow- 
ing for more detail and/or coverage of a larger area. The latter could 
be done simply by using pointers to indicate bounds on current memory 
space, replacing the unused parts with newer terrain information. 

6.1.k The Path Selection Algorithm 

Much more testing of the Path Selection Algorithm capabilities should 
be done. 

Certain basic assumpv'ons should also be modified. For example, the 
vehicle size could be extended to its actual physical dimensions by a 
slightly more comrlicated square blocking scheme. The choice of paths 
could be modified to include the other four squares at 45° increments 
from the adjacent squares. This would ease constraints on the turning 
radius imposed by the vehicle dynamics. 

The dead end zone created by an obstacle presently extends infinitely 
far back from the obstacle on the side of the target. Its extent could 
be limited, and the vehicle might therefore never enter it or never be 
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caxisht in a blocked zone. 

The short range sensor simulation contained in the Terrain Modeller 
might also be improved » or an existing short range sensor might be inter- 
faced "With this simulation. 

A better emergency algorithm might be developed which backs the 
vehicle exactly along its previous path rather than choosing any avail- 
able back-up path. 

Obstacles resulting from slopes should be treated in a different 
manner than discrete obstacles. Cases of combinations of slopes and small 
obstacles which are traversable in themselves, but barriers when combined, 
should also be examined. 

6.2 Conclusions 

The path selection system developed requires a large amount of com- 
putational time and storage. Hence, it should be used primarily "In the 
large" rather than at each step along the route. An efficient short range 
system should be used for detailed path selection, once the global trend 
of the terrain has been determined. 

The interdependence of program modules must be cut to an absolute 
minimu. An example of this would be the introduction of additional noise 
processing to remove spurious obstacles from the terrain grid map. Often, 
however, problems are difficult to isolate and are identified only at a 
later stage of the calculations. Thus, system design is necessarily an 
interactive process, 

A Path Selection Algorithm and Terrain Modeller which also address 
slope problems as well as discrete obstacles should be developed. 
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Despite the problems encountered, the edge detection approach has 
several ma^or advantages, such as: 

(1) a comparative lack of noise sensitivity, compared to previous 
sensor systems , 

(2) the ability to distinguish obstacles from slopes and, 

(3) a long-range permanent system memory. 

Thus, the edge detection approach is a promising basis for a path 
selection system. 
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